Adaptively controlled position prediction system

ABSTRACT

Ship&#39;&#39;s position predictor using sampled-data signal as input to a two-point predictor computer and having an adaptive correction system responsive to the predictor computer output for refining the prediction.

United States Patent Canfield [54] ADAPTIV ELY CONTROLLED POSITION PREDICTION SYSTEM [72] inventor:

[52] US. Cl ..235/150.2, 1 14/222, 235/150.1 [51] Int. Cl. ..G06f 15/50 [58] Field ofSearch ..235/150.2, 150.1,61.5 R,61.5 E,

[451 May 23, 1972 [56] References Cited UNITED STATES PATENTS 2,901,996 9/1959 B611 ..l14/122 3,221,238 11/1965 Unger et a]. ..235/150.2 X 3,428,788 2/1969 Fisher et a1. ..235/150.2

Prir nary xaminer-Eugene G. Botz Attomey-John F. McDevitt, Frank L. Neuhauser, Oscar B. Waddell and Joseph B. Form-an ABSTRACT 1 Ships position predictor using sampled-data signal as input to a two-point predictor computer and having an adaptive correction systern responsive to the predictor computer output for refining the prediction.

7Claims,9DrawingFigures 4s a 56 r f" SHIP F oL lt siER SERVO ELEMENT MECHANISM v SHIPS POSITION e TRANSDUCER 52 54 V DATA R PRED|CT|ON D ADAPTIVE E 50 SAMPLER N t N CORRECTION N PERIOD T COMPUTER COMPUTER Patented May 23, 1972 4 Sheets-Sheet 1 iwl ZOTGEMKQ mmQmO OWEN m wI I Z m mm m Aw v mm INVENTQR EUGENE B. CANFIELD HIS ATTORNEY Patented May 23, 1972 4 Sheets-Sheet Z 2 R STORE FOR ONE R N J N-1 SAMPLING PERIOD ADDER N N-l K 6 SCALER K(RN RN1) ADDER N8 ON .TWO POINT STRAIGHT LINE PREDICTION FIG. 4

IO N STORE FOR ONE ADDER N SAMPLING PERIOD N DOUBLER SCALER N SINUSOIDAL TWO POINT PREDICTION FIG. 5

INVENTOR EUGENE B. CANFIELD HIS ATTORNEY Patented May 23, 1972 3,665,168

4 Sheets-Sheet 5 ADDER 2o I} r 7+ 3 RN PREDICTION DN D EN COMPUTER DER ER N v SERVO 30 ru-1 STORE ADDER "2s 3O 32 34 R PREDICTION N J N COMPUTER ADPER ADDER SERVO EN=( DN e )+(0 e )=D 0 26 INVENTOR FI 7 EUGENE B. CANFIELD HIS A TTORNEY Patented May 23, 1972 3,665,168

4 Sheets-Sheet 4 36 T D STORE ADDER 2o r 4g R PREDICTION ADDER ADD COMPUTER L ER EN D (RN DN 1) e SERVO FI G. 8

46 a 56 I" f SAP FOEFASZER SERVO ELEMENT MECHANISM SHIPS POSITION e TRANSDUCER N 7 52 53 r DATA R D ADAPTIVE E 5 SAMPLER N ii 52532: N CORRECTION. N

PERIOD T COMPUTER INVENTOR Fl G. 9 EUGENE B. CANFIELD HIS ATTORNEY ADAPTIVELY CONTROLLED POSITION PREDICTION SYSTEM BACKGROUND OF THE INVENTION The invention relates to a sampled-data system for predicting the periodic motion of a ship or other vehicle, thereby enabling power drives to follow the vehicle's motion.

Analog power drives have previously been used to follow a ship's motion. One prior system used lead networks on a position servos stabilizing tachometer feedback to provide a high gain at ships motion frequencies. Another prior system supplied a speed controller servo (e.g. the inner loop of a position servo) with a signal indicative of the rate of ships motion developed by a stable element and an analog computer. Another prior system uses direct removal of ships motion by on-mount gyro stabilization.

SUMMARY OF THE INVENTION A sampled-data system allows the use of digital techniques to predict a future position or attitude of a ship or other vehicle based upon past measurements. For example, the roll of a ship is roughly sinusoidal, as determined primarily by the ships natural frequency of oscillation and the frequency of the ocean's waves. It is necessary to compensate for this motion for. gun directing servomechanisms and similar devices. The

present invention provides a mathematically computed predicted value based solely upon previously sampled data. This computed predicted value is then furtherrefined bycomparison with the value which actually occurs in a process ,of adaptive correction.

BRIEF DESCRIPTION OF THE DRAWINGS for deriving a correction signal based on thepredicted position.

FIG. 8 is a block diagram of an adaptive correction system for correcting the predicted position.

FIG. 9 is an overall block diagram of a ships position follower using prediction and adaptive correction systems.

DESCRIPTION OF THE PREFERRED EMBODIMENTS There are numerous prediction formulas foruse in sampleddata systems, and no exhaustive listing can be given here. Those which follow are some of the simpler and more useful formulas, and are limited to the use of two points to predict a third point.

In a sampled-data system, signals are sampled regularly at a timing interval T, If one time instant is called t,,, the previous time instant T, earlier) is called 1,, 1 and the later time instant is called -l, and so on. The value of signal R sampled at L,- is called R and so on. The predicted signal value D derived with data on hand at time t is called D and is a prediction of the value of R The simplest and least useful prediction is a zero-order or one-point prediction and merely assumes that D R or R 12,-. The results of such a prediction, as applied to a sinusoidal input signal are illustrated in FIG. I.

A better prediction is the two-point straight line prediction which assumes that Dx R K (R R If a first order prediction is used, the K becomes one and the equation becomes D 2R R This is illustrated in FIG. 7 in connection with a sinusoidal input signal. Rather large errors are still present with the sinusoidal signal.

A nearly perfect two-point prediction for a sinusoid can be obtained if the angular velocity (o of the sinusoid is known. The equation then becomes D, 2R cos w T R, The success of this equation in predicting sinusoid values is shown in FIG. 3.

Although a typical ship's motion is not precisely sinusoidal, use of the sinusoidal prediction of FIG. 3 typically gives less than half the error obtained using the first order prediction of FIG. 2.

' FIG. 4 is a block diagram of a computer for making the first order prediction according to the equation D3 R K (R R This prediction computer can be mechanized as a pulse analog or special-purpose digital computer or the equation can be programmed on a general-purpose digital computer. The input signal R is stored in store 2 for one sampling period to derive signal R Signal R is subtracted from signal R, in adder 4 to derive signal R R which is sealed in scaler 6 to derive signal K (R R Signal K (R,-- R is added in adder 8 to signal R to derive predicted output signal D FIG. 5 is a block diagram of a computer'for making the sinusoidal two-point prediction according to the equation Dy 2R, cos w T R This prediction computer can also be mechanized several 'ways. To simplify special-purpose computer mechanization of this equation, it may be desirable to set cos m T to a preset value K, allowing the mechanization of D,,- ZKR R, In order to accommodate different sized ships with different predominate periods, the sampling period may be adjusted to keep K a constant. However, any selection of (on for a particular ship will necessitate a compromise, because the roll and pitch periods of the ship will not be the same. In FIG. 5, the input signal is stored in store 10 forvone sampling period to derive signal R Signal R is also doubled in magnitude doubler'l2 and scaled in scaler 14 to derive signal ZKR Adder l6'is used to subtract signal R from signal 2KR, to derive the predicted output signal D Three types of adaptive correction are disclosed for application to the two disclosed prediction computers. Just as other prediction computers are possible, other adaptive correction systems may also be used in the correction of the predicted values. The adaptive control system of FIG. 6, when used in connection with the sinusoidal prediction system of FIG. 5, provided the best combination for the least error in following a typical ships motion.

However, first-order prediction according to FIG. 4 (where K I) used in connection with the adaptive control system of FIG. 8 is only slightly less accurate. Choice between these methods depends upon further evaluation of a large sample of the motion of the type of ship to be used and the relative complexity of implementation within available computers. In

general, adaptive control according to FIG. 6 may be simplest because no additional storage of past data is required. I

FIGS. 6, 7, and 8 are block diagrams of various adaptive correction systems, each using the output of a prediction computer 20 as the basis of further correction. The prediction computer may be constructed according to either FIG. 4 or FIG. 5, although other prediction computers are equally applicable. In each adaptive correction system, a servo response feedback signal 0 is applied to the correction system as an indication of the required type of correction.

In FIG. 6, the servo response Q,- is subtracted in adder 22 from the prediction computer input signal R to derive a signal R 0 The servo response 0, is also subtracted in adder 24 from the prediction computer output Dy to derive a signal D 0 Signals R 9 and D 0 are added in adder 26 to derive the adaptively corrected output signal E In the adaptive correction system of FIG. 7, the prediction computer output D, is stored in store 28 for one sampling period to derive a delayed signal D The servo response signal O is subtracted in adder 30 from signal D,,-., to derive a signal D, 0 The servo response 0 is also subtracted in adder 32 from prediction computer output D, to derive a signal D, 0 Signals D, 0 and D 6, are added in adder 34 to derive an adaptively corrected output signal E In the adaptive correction system of FIG. 8, the output signal D from the prediction computer is stored in store 36 I for one sampling period to derive a delayed signal D,,-.,. The delayed signal D, is subtracted in adder 38 from prediction computer input signal R to derive an output signal R D Signal R D, is added in adder 40 to signal D to derive a signal D R D from which in adder 42 the servo response signal is then subtracted to derive adaptively corrected output signal E When using adaptive corrections together with prediction, it may be desirable to limit the amount of adaptive correction that may be applied in order to provide for greater stability. If the adaptive corrections require additional storage, as in the systems of FIGS. 7 and 8, then the storage requirements are the same as if three-point prediction were used. However, the mathematical manipulation required is less complex with the adaptive correction systems. With the adaptive correction system of FIG. 6, no extra store is required for the correction system.

The servomechanism 44 used in each of the adaptive correction systems must be chosen by matching its velocity error coefficient with the sampling period of the system. Where the sampling period T 0.1 sec, the servo must drive the response 0 (developed by prediction) in 0.1 sec. Since the sampling frequency in cycles per second should equal the servo zero axis crossover frequency in radians per second, the velocity error coefficient of the drive should be radians/second/radian.

FIG. 9 is an overall block diagram of a system in which the adaptive correction system is used in connection with a ship to activate a ship following element, such as a gun mount. The position of a ship 46 (e.g. roll, yaw) is measured by a transducer 48. The transducer output is sampled by a data sampler 50 having a sampling period T The sampled data is applied to a prediction computer 52 and adaptive correction computer- 54 of the type disclosed in connection with previous figures. The adaptive computer controls a servomechanism 56 as previously described. Servo 56 drives the ship following element 58 to the predicted ships position.

Thus, it is seen that the overall sampled-data prediction system includes a prediction means and an adaptive correction means, both of which are capable of assuming several forms for different equations of prediction. The invention reduces the complexity of a prediction system for a given order of accuracy by use of adaptive correction.

Structurally, the individual elements of the disclosed circuits are all well-known in the sampled data control field. The store for one sampling period elements 2,10, 28 and 36 can be any zero-order hold circuit of the type discussed on pp. 48-50 of Jurys Sampled-Data Control Systems, John Wiley & Sons, 1958. The adders 4, 16, 22, 24, 26, etc., can be any summing amplifier of the type typified by amplifier 36 in US. Pat. No. 3,225,179. An analog inverter can be placed in any input or output path requiring signal inversion. Doubler 12 can use any suitable amplifier having an output signal with twice the amplitude of the input signal. Scalers 6 and 14 can be potentiometer. Thus, all of the basic elements are seen to be found in the prior art.

What is claimed as new and desired to secure by Letters Patent of the United States is:

l. A system for predicting the position of a vehicle subject to periodic motion at a future instant of time and driving a servomechanism to follow the position comprising:

A. means for providing sampled data R corresponding to the vehicle's position,

B. prediction means receiving the sampled data R and using a predetermined prediction formula for deriving a value Dy of the vehicles position predicted for said future instant of time,

C. an adaptive correction means for receiving the predicted value signal Dy and responsive to at least one additional servo response signal 0 representative of the vehicles instantaneous actual position for further refining the predicted value to derive a signal 15 to more accurately approximate the vehicles future position, and

D. a servomechanism responsive to said signal E for deriving said additional signal 0 as a servo response signal and for controlling a vehicle following element.

2. A system according to claim 1 wherein said prediction means further comprises:

A. storage means for storing the sampled data signal R for one sampling period to derive a delayed signal Ry 1 and B. computation means for generating said predicted value Dy according to an equation Dy R K (R R where K is a scaling constant which may be unity.

3. A system according to claim 1 wherein said prediction means further comprises:

A. storage means for storing the sampled data signal R for one sampling period to derive a delayed signal R -and B. computation means for generating said predicted value D according to an equation Dy 2KR R where K is a scaling constant.

4. A system according to claim 3 wherein said scaling constant is chosen to approximate cos w T where said sampling period is T and the period of movement of said vehicle is Ham.

5. A system according to claim 1 wherein said adaptive correction means further comprises computation means responsive to said signals R D and 0 for deriving said signal E according to the equation E D, R 20 6. A system according to claim 1 wherein said adaptive correction means further comprises:

A. storage means for storing the predicted signal value 0;, for one sampling period to derive a delayed signal D and B. computation means responsive to said signals Dy, D and 0 for deriving said signal E according to equation 7. A system according to claim 1 wherein said adaptive correction means further comprises:

A. storage means for storing the predicted signal value Dy for one sampling period to derive a delayed signal D and B. computation means responsive to said signals Dy, D

R and 0 for deriving said signal E according to equation E Dy (R,- D, 0 

1. A system for predicting the position of a vehicle subject to periodic motion at a future instant of time and driving a servomechanism to follow the position comprising: A. means for providing sampled data RN corresponding to the vehicle''s position, B. prediction means receiving the sampled data RN and using a predetermined prediction formula for deriving a value DN of the vehicle''s position predicted for said future instant of time, C. an adaptive correction means for receiving the predicted value signal DN and responsive to at least one additional servo response signal theta N representative of the vehicles instantaneous actual position for further refining the predicted value to derive a signal EN to more accurately approximate the vehicle''s future position, and D. a servomechanism responsive to said signal EN for deriving said additional signal theta N as a servo response signal and for controlling a vehicle following element.
 2. A system according to claim 1 wherein said prediction means further comprises: A. storage means for storing the sampled data signal RN for one sampling period to derive a delayed signal RN 1 and B. computation means for generating said predicted value DN according to an equation DN RN + K (RN - RN 1), where K is a scaling constant which may be unity.
 3. A system according to claim 1 wherein said prediction means further comprises: A. storage means for storing the sampled data signal RN for one sampling period to derive a delayed signal RN 1 and B. computation means for generating said predicted value DN according to an equation DN 2KRN - RN 1, where K is a scaling constant.
 4. A system according to claim 3 wherein said scaling constant is chosen to approximate cos omega RTS, where said sampling period is TS and the period of movement of said vehicle is (1/ omega R).
 5. A system according to claim 1 wherein said adaptive correction means further comprises computation means responsive tO said signals RN, DN and theta N for deriving said signal EN according to the equation EN DN + RN - 2 theta N.
 6. A system according to claim 1 wherein said adaptive correction means further comprises: A. storage means for storing the predicted signal value DN for one sampling period to derive a delayed signal DN 1, and B. computation means responsive to said signals DN, DN 1, and theta N for deriving said signal EN according to equation EN DN + DN 1 - 2 theta N.
 7. A system according to claim 1 wherein said adaptive correction means further comprises: A. storage means for storing the predicted signal value DN for one sampling period to derive a delayed signal DN 1, and B. computation means responsive to said signals DN, DN 1, RN and theta N for deriving said signal EN according to equation EN DN + (RN - DN 1) - theta N. 